import machine
import utime

def sweap_servo(pin):
    servo_freq = 50
    duty_min = 2000  # 对应 0 度
    duty_max = 8000  # 对应 180 度
    
    servo = machine.PWM(machine.Pin(pin))
    servo.freq(servo_freq)

    # 将舵机初始化到最小角度位置
    servo.duty_u16(duty_min)
    utime.sleep_ms(500)

    # 控制舵机运动
    for duty in range(duty_min, duty_max):
        servo.duty_u16(duty)
        utime.sleep_us(500)
        
    for duty in range(duty_max, duty_min, -1):
        servo.duty_u16(duty)
        utime.sleep_us(500)

    # 将舵机返回到初始位置
    servo.duty_u16(duty_min)
    utime.sleep_ms(500)

while True:
    sweap_servo(26)
    sweap_servo(27)